#include "mode_cleaning.h"
#include "actuator_control.h"
#include <stdio.h>

// 初始化清洗模式
void mode_cleaning_init(const SystemConfig *config) {
    // 清洗模式无需特殊初始化
}

// 进入清洗模式
void mode_cleaning_enter(void) {
    printf("Entering cleaning mode\n");
    
    // 立即开启膨化泵和主电机
    actuator_set_pump(true);
    actuator_set_main_motor(true);
}

// 退出清洗模式
void mode_cleaning_exit(void) {
    printf("Exiting cleaning mode\n");
    
    // 关闭相关设备
    actuator_set_pump(false);
    actuator_set_main_motor(false);
}

// 处理清洗模式逻辑
ModeStatus mode_cleaning_process(void) {
    // 清洗模式持续运行，直到外部终止
    return MODE_STATUS_RUNNING;
}
    